A key prerequisite for planning manipulation with locomotion of humanoid robots in complex environments is to find a valid end-pose with a stable stance location and a collision-free, balanced full-body configuration. Prior work based on the Inverse Reachability Map assumed that the feet are placed next to each other around the stance location on a horizontal plane. Additionally, the success rate was correlated with the coverage density of the sampled space, which is in turn limited by the memory needed for storing the map. In this work, we present a framework that uses a Paired Forward-Inverse Dynamic Reachability Map to exploit a greater modularity of the robot’s inherent kinematic structure. The combinatorics of this novel decomposition allows greater coverage in the high dimensional configuration space while reducing the number of stored samples. This permits drawing samples from a much richer dataset to effectively plan end-poses for both single-handed and bimanual tasks on uneven terrains. This novel method was demonstrated on the 38-DoF NASA Valkyrie humanoid by utilizing and exploiting whole body redundancy for accomplishing manipulation tasks on uneven terrains while avoiding obstacles.
展开▼